// #include <unitree/robot/go2/sport/sport_client.hpp>
#include <unitree/robot/b2/sport/sport_client.hpp>

// sudo ./b2_sport_client enx000ec62796bd
// 192.168.123.161

int main_tmp()
{
    /*
     * Initilaize ChannelFactory
     */
    unitree::robot::ChannelFactory::Instance()->Init(0);
    // unitree::robot::go2::SportClient sc;
    unitree::robot::b2::SportClient sc;
    sc.SetTimeout(5.0f);
    sc.Init();

    //Test Api
    while (true)
    {
        // int32_t ret2 = sc.StandUp();
        // std::cout << "Call Move ret2:" << ret2 << std::endl;

        // usleep(2000);
        int32_t ret = sc.Move(0.5, 0.0, 0.0);

        std::cout << "Call Move ret:" << ret << std::endl;

        usleep(1000);
    }

    return 0;
}
